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Abstract of DE3741259 

For the autonomous steering of a vehicle, a sensor system is proposed, with which the environment of 
the vehicle is used as reference for navigation and steering. During the journey, the environment 
relative to the vehicle is continuously surveyed by a laser distance imaging system. The position of the 
vehicle is forecast with data from an integrated navigation system. These respective calculated position 
data are used to transform the measured data from the environmental surveying into a fixed coordinate 
system describing the environment. Simultaneously, the environment is recognised by comparison of 
the data from the environmental surveying with stored data of the environment. The results of this 
comparison are used for correcting the fundamentally erroneous data from the integrated navigation 
system with respect to the position of the vehicle. The distance imaging information is furthermore used 
for warning of obstacles and the detection of moving objects. 
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Die Erfindung betrifft ein Verfahren sowie eine Vor- 
richtung zur Durchfuhrung dieses Verfahrens nach An- 
spruch 1. 

Die Erfindung findet vorzugsweise Anwendung in 
Fahrzeugen, mit denen der innerbetriebliche Material- 
transport automatisiert durchgefiihrt werden soli, etwa 
bei Fahrzeugen, mit denen bestimmte Wege oder Weg- 
muster wie sie bei Reinigungsmaschinen vorkommen, 
gefahren werden sollen, und bei autonomen, mobilen 
Robotern, bei denen der oder die Arbeitsarme auf einer 
mobilen Plattform montiert sind und auf diese Weise 
eine hone Beweglichkeit im ArbeitsprozeB bekommen. 
Dabei soil sich das Fahrzeug oder die mobile Plattform 
selbst d. h. autonom steuern. 

Bei den bisher bekannten fahrerlosen Transportfahr- 
zeugen hat man die Umgebung mit kiinstlichen "Mar- 
ken" wie z. B. im Boden eingelassene Drahte, Magnete, 
auf den Boden gemahlte oder geklebte Markierungen 
aller Art etc. versehen. Es wurden einfache Sensoren 
verwendet, die diese Marken sicher erkennen. Man 
spricht in diesem Zusammenhang von einer verarmten 
Umwelt und meint damit, daB die Umgebung nur noch 
durch die sinnvoll eingebrachten Marken reprasentiert 
wird. Diese Marken schranken die Flexibility eines Sy- 
stems jedoch stark ein. Bei jeder Anderung muB die von 
den einfachen Sensoren wahrgenommene Umgebungs- 
markierung entsprechend mitgeandert werden. Dieses 
System von Markierungen wird bei groBen Anlagen 
sehr komplex und ist fur komplizierte Wegfiihrungen 
nichtgeeignet. 

Man kann dabei nicht von einer autonomen Steue- 
rung sprechen, da die Fahrzeuge z. B. dem Draht folgen 
miissen und keine im Fahrzeug befindliche Intelligenz 
die Wegfindung unterstutzt. Herkommliche fahrerlose 
Transportsysteme werden von einem Leitrechner zen- 
tral gesteuert. Im Leitrechner muB zu jedem Zeitpunkt 
die vollstandige Information uber den Ort aller Fahr- 
zeuge vorliegen. Dies fiihrt verstandlicherweise bei gro- 
Ben Systemen zu sehr hohem Aufwand an Kommunika- 
tion und Steuerung. Die Fahrzeuge haben insofern kei- 
ne Autonomic 

Bekannt sind Systeme, bei denen die Steuerung der 
Fahrzeuge mit einer Kamera unterstutzt wird. Diese 
Kamera sieht entweder eine verarmte Umgebung (z. B. 
einen auf den Boden befindlichen Strich, etwa eine 
Fahrbahnbegrenzung) oder die Umgebung direkt. Die 
erste Sorte kann nicht als autonom bezeichnet werden. 
Die zweite Sorte ist nur mit mit erheblichen Aufwand 
realisierbar. Erste militarische Versuchsfahrzeuge in 
den USA sind sehr langsam, da die Zeit fur die Berech- 
nung der Informationen aus dem Bild sehr groB sind. 

Wahrend herkommliche fahrerlose Transportfahr- 
zeuge also ihren Weg an einem im Boden verlegten 
Draht oder auf den Boden aufgebrachte Farbbander mit 
geeigneten Sensoren detektieren, besteht hier die erfin- 
derische Aufgabe darin, ein System und ein Verfahren 
anzugeben mit dem die Umgebung wahrgenommen, 
Wege "gelernr und auf Befehl Fahr- oder Transportauf- 
trage ausgefuhrt werden konnen. Dies ist nur mit einem 
Sensorsystem moglich, das diejenige Information aus 
der Umgebung entnimmt, die Orientierung und Naviga- 
tion mit geringem Aufwand ermoglicht. Eine spezielle 
Infrastruktur wie z. B. die Drahte, metallische Raster 
oder Farbstreifen sollen nicht erforderlich sein. 

Prinzipiell bietet die Umgebung durch ihre korperli- 
che Struktur und Form genugend Information zur 



Orientierung. 

Die Umgebung ist 3-dimensional. Das bedeutet fur 
die Vermessung die Aufnahme und Auswertung von 
3-D-BiIdern. 

5 Die Losung dieser Aufgabe wurde sehr groBe Vortei- 
le mit sich bringen, weil fur derartige Fahrzeuge keine 
Installationen an Decken oder Boden erforderlich sind, 
geringe Anforderungen an Bodenqualitat gestellt wer- 
den, (Genauigkeit, Material, Ebenheit), extrem schnelles 
io Lernen neuer Kurse durch Teach-in moglich sind und 
sowohl in Hallen als auch im AuBengelande gefahren 
werden kann und damit der Aufwand an Kommunika- 
tion, InfrastrukturmaBnahmen und Steuerungstechnik 
erheblich reduziert wiirde. 
15 Die erfinderische Losung der Aufgabenstellung geht 
von folgenden Oberlegungen aus: 

Fur die sensorielle Erfassung der Umgebung wird ei- 
ne direkte Umgebungsvermessung mit aktiven Strah- 
lern durchgefiihrt. Um die Umgebung dabei in einer 

20 Weise zu vermessen, die eine Wiedererkennung bei ei- 
ner zweiten Vermessung zuIaBt, ist eine relativ feine 
Oberflachenabtastung erforderlich. Dies kann mit La- 
sern durchgefiihrt werden, weil nur diese ausreichende 
Reichweite, feine Strahlbiindelung und schnelle Di- 

25 stanzmessung ermoglichen. Mit einem Laserentfer- 
nungsmesser in Verbindung mit Winkelmessung des 
EntfernungsmeBstrahi werden deshalb zur Umgebungs- 
vermessung Entfernung und Winkel relativ zum Fahr- 
zeug von Punkten auf den Objekten, die diese Umge- 

30 bung bilden gemessen. 

Die Zusammenfassung vieler MeBpunkte der Umge- 
bung ergibt ein sog. Entfernungsbild der Umgebung. Im 
zweidimensionalen Fall (z. B. Drehung des MeBstrahls 
in einer Ebene) gleicht das Entfernungsbild einem hori- 

35 zontalen Schnittbild durch Gegenstande die die Umge- 
bung reprSsentieren. Der Datenanfall bei diesem Sensor 
ist sehr hoch, da die moderne MeBtechnik MeBmittel 
bereitstellt sowohl die Entfernung als auch den Winkel 
in hoher Auflosung gemessen zu konnen. 

40 Ein weiteres erfindungsgemaBes Sensorsystem zur 
Losung der Aufgabe ist das Koppelnavigationssystem, 
mit dem die Bewegung des Fahrzeuges oder der mobi- 
len Plattform sensiert wird. Position und Vektor erge- 
ben sich aus der rechnerischen Integration der gemesse- 

45 nen vektoriellen Wegelemente langs des zuriickgeleg- 
ten Weges. Derartige Systeme miissen z. B. Radumdre- 
hungen und Radstellungen (Odometrische Systeme) 
oder sensieren Winkelanderungen mittels Kreisel (iner- 
tiale Systeme). Sie sind mit einem Fehler behaftet, der 

50 mit der zuriickgelegten Wegstrecke und ggf. Zeit 
wachst. Die MeBergebnisse dieser Systeme miissen des- 
halb standig korrigiert werden. 

Kurzzeitig liefern das Koppelnavigationssysteme 
sehr gute MeBergebnisse. Diese Tatsache wird erfin- 

55 dungsgemaB bei der Entfernungsbildaufnahme mehr- 
fach benutzt. Da die Entfernungsbildaufnahme eine ge- 
wisse Zeit in Anspruch nimmt, sind die Aufnahmeorte 
fiir jeden MeBpunkt der Umgebung unterschiedlich. Die 
aus den Daten des Koppelnavigationssystems errechne- 

60 te Position erlaubt nun die vektorielle Addition von 
UmgebungsmeBwert und jeweiligem Aufnahmeort, so 
daB alle Umgebungspunkte auf ein festes Koordinaten- 
system transformiert werden konnen. Damit ist der Weg 
frei durch Zusammenwirkung beider Sensorsysteme die 

65 gesamte Umgebung in einem ortsfesten Koordinatensy- 
stem zu kartieren. Dies ist ein wiederholbarer Vorgang 
der bei einer Teach-in Fahrt aber auch bei jeder Wie- 
derholungsfahrt durchgefiihrt werden kann. 
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Da das Koppelnavigationsystem aber uber langere 
Strecken fehlerhafte Ergebnisse liefert wird erfindungs- 
gemaB vom absolut messenden Laser-Entfernungsbild- 
system zur Reduktion dieses Fehlers Gebrauch ge- 
macht Dies geschieht durch Vergleich der genauen Urn- 
gebungsmefldaten mit gespeicherten UmgebungsmeB- 
daten. Der absolute Positionsfehler wird dabei auf eine 
GrbBe reduziert, die kleiner als der MeBfehler des La- 
ser-Entfernungsbildsystems ist. Je genauer das Koppel- 
navigationssystem arbeitet, desto seltener ist eine Feh- 
lerreduzierung der Absolutposition mit Hilfe des Laser- 
Entfernungsbildsystem erforderlich urn den aktuellen 
Positionsfehler in vorbestimmten Schranken zu halten. 

Die Datenflut wird erfindungsgemafi on-line von ei- 
nem leistungsfahigen Zentralrechner abgearbeitet. Zu- 
satzlich kann durch geeignete Algorithmen die Daten- 
menge reduziert werden, indem auf ein ortsfestes Koor- 
dinatensystem transformierte Entfernungsbildteile 
durch einfache Kurven approximiert werden. Nach be- 
stimmten Kriterien werden die transformierten Entfer- 
nungsbilder nach wiedererkennbaren eindeutigen 
Merkmalen abgesucht und die zugehorigen Ortskoordi- 
naten und Merkmalart gespeichert. 

Ein einfaches Beispiel eines deranigen Orientierungs- 
elementes ist eine Ecke, fur deren Vorhandensein sich 
eindeutige Kriterien aufstellen lassen und die eindeutig 
in einem Koordinatensystem lokalisiert, beschrieben 
und wiedererkannt werden kann. 

Viele zeitlich nacheinander aufgenommene, auf ein 
ortsfestes Koordinatensystem transformierte Entfer- 
nungsbilder konnen rechnerisch zu einem Entfernungs- 
bild der Umgebung zusammengesetzt werden. 

Die Vorteile des erfindungsgemaflen Sensor Systems 
bestehen u. a. darin, daB die Auswertung der Umge 



stem und leistungsfahiger Zentralrechner erlauben die 
grundsatzliche Losung der Aufgabe der Steuerung au- 
tonomer Fahrzeuge oder mobiler Plattformen. Fur gro- 
Bere Fahrzeuge oder mobile Plattformen konnen meh- 
rere Laser- Bildsysteme im erfindungsgemaBen Sensor 
System z. B. fur die Abdeckung nach vorn und hinten 
integriert sein. 

Ein typisches Ausfuhrungsbeispiel des erfindungsge- 
maBen Verfahrens und zugehorige Vorrichtungen sind 
io in den Figuren 1 bis 6 schematisch wiedergegeben. Es 
zeigt 

Fig.l eine erfindungsgemaBes Sensorsystem auf ei- 
nem Fahrzeug oder einer mobilen Plattform als Block- 
diagramm, 

15 Fig. 2 einen erfindungsgemaBen Zentralrechner als 
Blockdiagramm, 

Fig. 3 schematische Korrektur der Position durch 
Umgebungserfassung, 
Fig. 4 wie das erfindungsgemaBe Sensorsystem die 
20 Umgebung sieht, 

Fig. 5 einTransportfahrzeug mit erfindungsgemaBem 
Sensorsystem in Schragansicht, 

Fig. 6 Beispiel einer mobilen Plattform mit erfin- 
dungsgemaBem Sensorsystem. 
25 Das typische Ausfuhrungsbeispiel ist in Fig. 1 als 
Blockdiagramm dargestellt. Es handelt sich urn ein auto- 
nomes Fahrzeug mit einem Fahrwerk mit drei RSdern, 
von denen ein einzelnes Rad 10a angetrieben und ge- 
lenkt wird und die restlichen zwei Rader 10b, 10c auf 
30 einer Achse frei mitlaufen. Der Entfernungsmesser 1, 
angetrieben mit dem Motor 2, drehbar urn die als Pfeil 
dargestellte Hochachse des Fahrzeuges, sendet einen 
MeBstrahl 30 rundum, Der Winkel des MeBstrahls wird 
mit dem Winkelencoder 3 gemessen wird. Entfernung 



stemsteuereinheit 4 ubertragen zu Datentelegrammen 
zusammengefaBt und an den Zentralrechner 5 ubertra- 
gen. 

Die Bewegung des Fahrzeuges wird an den RSdern 
106, lOcmit den Winkelencodern 9 sensierL Die Winkel- 
anderungen werden in der Steuereinheit 8 des Koppel- 
navigationssystems mit dem Lenkwinkel, der mit dem 
Winkelsensor 1 1 gemessen wird, vorverarbeitet, zu Da- 
tentelegrammen zusammengefaBt und an den Zentral- 



bungsvermessung fast immer auf die Erkennung und 35 und Winkel werden in die Laser-Entfernungsbildsy 
Berechnung von kleinen Entfernungsbildunterschieden 
(dem akkumulierten Fehler des Koppelnavigationssy- 
stems) beschrankt ist, weil meistens ahnliche, auf das 
ortsfeste Koordinatensystem transformierte Entfer- 
nungsbilder zur Orientierung und Navigation miteinan- 40 
der zu verglichen werden. Dies ist ohne weiteres on-line 
durchfuhrbar. Da mit Hilfe des Koppelnavigationssy- 
stems die Zeit zwischen diesen Auswertungen uber- 
bruckt werden kann, steht das Laser-Entfernungsbildsy- 

stern noch fur andere Aufgaben wie z. B. Hinderniser- 45 rechner 5 iibertragea 

kennung, Hinderniswarnung und Hindernisanalyse zur Mit den Ultraschall Sensoren 7 ... In wird die nahere 
Verfiigung. Umgebung urn das Fahrzeug nach Hindernissen ge- 

Von einem Hinderniswarnsystem wird eine Reichwei- pruft, indem jeder Sensor Schallpulse aussendet, deren 
te uber einige Meter, Wahrnehmung jedes Hindernisses Laufzeit zu einem Objekt und zuruck in der Uhraschall- 
in der nahen Umgebung, groBer Winkelarbeitsbereich, 50 steuereinheit 6 gemessen wird und vorverarbeitet zum 
Erkennung und Unterscheidung von bewegten Hinder- Zentralrechner 5 ubertragen. 

nissen, geringe Herstellungskosten gefordert Alle For- Mit einem Handbediengerat 13, das mit dem Zentral- 
derungen smd in idealer Weise automatisch durch das rechner 5 verbunden ist kann das Fahrzeug manuell 
technische Prinzip des Laser-Entfernungsbildsystems gesteuert werden und es konnen uber die Tastatur die- 
erfullt. Es stellt ein ideales Hinderniswarnsystem fur 55 ses Gerates Kommandos und Informationen in das 



60 



grofiere Reichweiten dar. 

Unterstutzt wird das weitreichende Laser-Bildsystem 
durch ein Ultraschall Hinderniswarnsystem. Mit diesem 
System werden auch auf der Fahrbahn liegende Hinder- 
nisse noch erfaBt 

Dariiber hinaus ist das Fahrzeug mit Notausschaltern 
und Kontaktschalter ausgerustet die unmittelbaren Be- 
riihrungsschutz gewahrleisten. 

Auf diese Weise ist ein gestaffeltes arbeitendes Si- 
cherheitssystem im Sensorsystem integriert, das den 65 
durch die autonome Steuerung erhohten Sicherheitsan- 
forderungen entsprichL 

Laser-Entfernungsbildsystem, Koppelnavigationssy- 



Fahrzeug eingegeben werden. 

Mit dem IR-Kommunikationsgerat 13, das mit dem 
Zentralrechner 5 verbunden ist, kann das Fahrzeug In- 
formationen senden oder Empfangen. 

Mit der Kamera 14, die ebenfalls mit dem Zentral- 
rechner 5 verbunden ist, konnen Bilder der Umgebung 
aufgenommen und dem Zentralrechner zugefuhrt wer- 
den. 

Der Zentralrechner generiert aus den ihm zugefuhr- 
ten Daten und Befehlen, aus den Messungen der Urn- 
welt und aus seinem gespeicherten Bestand an Informa- 
tionen Steuerkommandos, die in der Fahr- und Lenk- 
steuereinheit 18 in Ansteuersignale fur den Fahrmotor 



Dnicrwirv «nc 



OS 37 

5 

19 und Lenkmotor 20 umgesetzt werden. 

Da die zu verarbeitende Datenmenge in diesem Aus- 
fuhrungsbeispiel betrachtlich ist wird der Zentralrech- 
ner 5 (Fig. 2) aus Parallelprozessoren 15 gebildet um die 
verschiedenen Sensordaten parallel und schnell zu ver- 5 
arbeiten. Jedes periphare Sensorsystem 4, 6, 8 ist mil 
eigenen Prozessoren ausgestattet, die direkt mit be- 
stimmten Parallelprozessoren 15 aus dem Zentralrech- 
ner kommunizieren. Die Kommunikation geschieht 
uber standardisierte, schnelle, serielle Schnittstellen, 10 
sog. Links. Der Prozessor 16 liefert die Daten der 1R- 
Kommunikationseinheit 13 und des Bediengerates 12 
vorverarbeitet uber einen Link an das Parallelprozes- 
sorsystem. Die Arbeitsprogramme, Umgebungsdaten 
und Weginformationen werden in der vom Prozessor 16 15 
verwalteten Permanentspeichereinheit 17 verwaltet 
und bei Bedarf in die jeweiligen Arbeitsspeicher 15a der 
Parallelprozessoren 15 transferiert 

Zur Erlernung der Umgebung werden mit einem 
Fahrzeug die Wege abgefahren und entsprechende Hin- 20 
weise bezuglich der Strecke eingegeben. Dies geschieht 
mit Hilfe der Handbedieneinheit 13 wahrend einer Te- 
ach-in Fahrt Schon wahrend dieser Teach-in Fahrt 
wird die Umgebung permanent vermessen und die Um- 
gebungs- und Positionsdaten oder die entsprechenden 25 
reduzierten Daten gespeichert. Die Speicherung erfolgt 
auf der Permanentspeichereinheit 17, deren Jnhalt du- 
bliziert und somit fur weitere Fahrzeuge nutzbar ge- 
macht werden kann. Diese Teach-in Fahrt ahnelt dem 
Teach-in bei Handhabungsrobotern. 30 

Fig. 3 veranschaulicht die Art und Weise der genauen 
Navigation. X, Y stellt das ortsfeste Koordinatensystem 
dar. Das Fahrzeug hat den Befehl den Weg 23 zu fahren 
und die Umgebungsinformation 25 gespeichert. Es fahrt 
aber tatsachlich den Weg 24 weil die Daten der Koppel- 35 
navigationsteuereinheit fehlerhaft sind. Bis zum Punkt 
22 hat die Umgebungsvermessung entsprechend An- 
spruch 1, das auf das ortsfeste Koordinatensystem 
transformierte Entfernungsbild 26 ergeben. Aus Ver- 
gleich der Entfernungsbilder 25 und 26 wird im Zentral- 40 
rechner die Verschiebung 21 errechnet, die als Korrek- 
turwert der aus den Daten der Koppelnavigationssteue- 
reinheit errechneten Position angebracht wird. Dies be- 
deutet, dafl gleichzeitig im Zentralrechner 5 Steuersi- 
gnale generiert werden, die dafur sorgen, daB die Moto- 45 
ren 19 und 20 das Fahrzeug wieder auf den Kurs 23 
bringen. Dieser RegelungsprozeB lauft kontinuierlich 
ab. 

Fig. 4 veranschaulicht wie das auf das ortsfeste Koor- 
dinatensystem transformierte Entfernungsbild dazu ver- 50 
wendet werden kann bewegte Fahrzeuge zu erkennen. 
Zwei aufeinanderfolgende Entfernungsbilder, in schnel- 
ler Folge aufgenommen, zeigen die Bewegung eines 
Fahrzeuges 28, 29 deutlich. Durch rechnerischen Ver- 
gleich der Entfernungsbilder wird die Geschwindigkeit 55 
und Fahrtrichtung ermittelt. Hindernisse wie z. B. 37 
werden leicht und friihzeitig erkannt und ortsrichtig 
vermessen. Aus den Daten 32 kann leicht durch Appro- 
ximationsrechnungen die reduzierte Entfernungsbildin- 
formation 31 errechnet werden und aus dieser die Eck- 60 
punkte 33a bis /! Diese Rechnungen verkleinern den zu 
speichernden Datenumfang betrachtlich und erleichtern 
die Wiedererkennung. 

Fig. 5 zeigt ein Ausfuhrungsbeispiel eines Transport- 
fahrzeuges mit erfindungsgemaBem Sensorsystem in 65 
Schragansicht. Dabei ist das Laser-Entfernungsbildsy- 
stem 1 bis 3 zentral unterhalb der Lastaufnahmemittels 
34 angeordnet und hat rundum Sicht zur Entfernungs- 



41 259 

6 

bildaufnahme dargestellt durch die MeBstrahlen 30. Die 
MeBrichtung ist horizontal vom Fahrzeug weggerichtet, 
so daB die Umgebung sowie Hindernisse erfaBt werden. 
Die Lastaufnahmemittel werden dabei um die Strahl- 
breite von wenigen cm erhoht angebaut Diese Konfigu- 
ration erlaubt neben der Rundumsicht die Umweltver- 
messung in Vorwarts- und Ruckwartsfahrt und Hinder- 
niswarnung in Vorwarts- und Ruckwartsfahrt 

Die Ultraschallsensoren 7 decken in diesem Ausfuh- 
rungsbeispiel den tieferen Bereich um das Fahrzeug zur 
Hinderniserkennung ab. Kontaktschutzeinrichtungen 
35 stellen eine weitere Sicherheitseinrichtung dar. 

Fig. 6 zeigt ein Ausfuhrungsbeispiel einer mobilen 
Arbeitsplattform mit einem erfindungsgemaBen Sen- 
sorsystem. Wie bei Fig. 5 wird die Rundumsicht durch 
den zentralen Einbau des Laserentfernungsmessers 1 
erzielt. Als Arbeitsmittel ist auf der mobilen Plattform 
27 ein Roboterarm 36 montiert, der in dieser Konfigura- 
tion frei beweglich ist. Das Laser-Entfernungsbildsy- 
stem in Verbindung mit einem Koppelnavigationssy- 
stem ermoglichen die freie Positionierung und Naviga- 
tion dieses Roboterarmes relativ zum Werkstuck. 

Patentanspruche 

1. Verfahren zur autonomen Steuerung eines Fahr- 
zeuges oder einer mobilen Plattform mittels eines 
Sensorsystems mit mindestens einem Laser-Entfer- 
nungsbildsystem, einem Koppelnavigationssystem 
und einem Zentralrechner, dadurch gekennzeich- 
net, daB mit dem Koppelnavigationssystem konti- 
nuierlich inkrementale Positionsveranderungen ge- 
messen werden, diese an einen Zentralrechner 
ubertragen werden, zur Berechnung von Position 
und Vektor addiert werden, mit dem Laser-Entfer- 
nungsbildsystem kontinuierlich wahrend der Bewe- 
gung Oberflachenpunkte der Umgebung oder Seg- 
mente der Umgebung mit einem oder mehreren 
EntfernungsmeBstrahlen hinsichtlich der Entfer- 
nung und des Winkels relativ zum Fahrzeug oder 
der mobilen Plattform vermessen werden, die MeB- 
ergebnisse der Umgebungsvermessung mit dem 
Vektor und der Position des Fahrzeugs oder der 
mobilen Plattform, zugehdrig zum Zeitpunkt der 
MeBpunktaufnahme in ein ortsfestes Koordinaten- 
system transformiert werden, die transformierten 
UmgebungsmeBdaten,die den akkumulierten Posi- 
tionsfehler aus den addierten Koppelnavigationssy- 
stem Daten enthalten, im Zentralrechner mit einem 
gespeicherten Informationsbestand uber die Um- 
gebung verglichen werden, die Koordinatenver- 
schiebung aus der aktuellen Messung und der ge- 
speicherten Information berechnet wird, die Posi- 
tion um die errechnete Koordinatenverschiebung 
korrigiert wird, die Abweichung der Position von 
der, sich aus der jeweiligen Aufgabe ergebenden 
Sollposition berechnet wird, diese Abweichung als 
Korrekturwert einer Regelschaltung zugefuhrt 
wird, die Steuersignale fur den Antrieb und die 
Lenkung ermittelt 

2. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB der Kurs aus der Aufgabenstellung im 
Zentralrechner selbsttatig berechnet wird. 

3. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB das ein per Rechner erstelltes Weg- 
netz in den Zentralrechner des Fahrzeuges einge- 
geben und dort gespeichert wird. 

4. Verfahren nach Anspruch 1, dadurch gekenn- 
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zeichnet, daB nach Einschalten des Fahrzeuges 
oder der Mobilen Plattform eine Umgebungsver- 
messung ablauft, Position und Vektor durch Ver- 
gleich mit dem gespeicherten Umgebungsinforma- 
tionen berechnet werden, das neue ortsfeste Koor- 5 
dinatensystem im Zentralrechner derartig festge- 
legt wird, daB die gemessene und gespeicherte Um- 
gebungsinformaiion ubereinstimmt. 

5. Verfahren nach Anspruchl, dadurch gekenn- 
zeichnet, daB bei Ausschalten des Fahrzeuges oder 10 
der mobilen Plattform die momentane Position und 
der momentaner Vektor permanent gespeichert 
werden. 

6. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB der Informationsbestand uber die 15 
Umgebung mit dem Laser-Entfernungsbildsystem 
wahrend eines Teach-in durch Verfahren des Fahr- 
zeugs oder einer mobilen Plattform auf dem ge- 
wunschten Kurs per Hand oder ferngesteuert per 
Hand bei gleichzeitiger Positions- und Umge- 20 
bungsvermessung mit dem Sensorsystem erzeugt 
wird 

7. Verfahren nach Anspruch 1 und 6, dadurch ge- 
kennzeichnet, daB die Umgebungsinformationen 
entweder direkt gespeichert wird, oder vorverar- 25 
beitete Daten gespeichert werden. 

8. Verfahren nach Anspruch 1 und 6, dadurch ge- 
kennzeichnet, daB zusatzlich eingegebene Daten 
uber besondere Wegmerkmale, Verkehrsregeln, 
Fahrkurselemente, Fahrtrichtung, Transportpunk- 30 
te und Umgebungsbereiche, die sich nicht fur 
Orientierungsberechnungen eigen und weitere auf- 
gabenspezifische Informationen gespeichert wer- 
den. 

9. Verfahren nach Anspruch 1 und 6, dadurch ge- 35 
kennzeichnet, daB der wahrend des Teach-in er- 
zeugte Umgebungsinformationsbestand als leicht 
wiedererkennbare Entfernungsbildelemente be- 
rechnet und gespeichert werden. 

10. Verfahren nach Anspruch 1, dadurch gekenn- 40 
zeichnet, daB bei UmgebungsverSnderung der Be- 
stand an Informationen uber die Umgebung im 
Zentralrechner selbsttatig verandert, erganzt oder 
reduziertwird 

11. Verfahren nach Anspruch 1, dadurch gekenn- 45 
zeichnet, daB die transformierten UmgebungsmeB- 
daten im Zentralrechner stiickweise mit einfachen 
Funktionen approximiert werden. 

12. Verfahren nach Anspruch 1 und 10, dadurch ge- 
kennzeichnet, daB die im Datenumfang reduzierten 50 
transformierten UmgebungsmeBdaten Daten oder 
die transformierten UmgebungsmeBdaten selbst im 
Zentralrechner auf leicht wiedererkennbare Ele- 
mente wie Geradenstucke, Ecken, Sprunge und de- 
ren Abstande untereinander untersucht werden, 55 
deren Orte oder Abstande gespeichert werden. 

13. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB auf das ortsfeste Koordinatensystem 
transformierte Entfernungsbild oder daraus redu- 
zierte Informationen durch Vergleich mit Entfer- 60 
nungsbildern von gespeicherten Objekten oder 
daraus reduzierten gespeicherten Informationen 
auf die Erkennung dieser Objekte analysiert wird 
und Steuersignale fur den Antrieb und die Lenkung 
daraus abgeleitet werden. 65 

14. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB die in das ortsfeste Koordinatensy- 
stem transformierten Entfernungsbilder des Laser- 



Entfernungsbildsystems fur Hinderniserkennung 
on-line (in Ist-Zeit) ausgewertet werden. 

15. Verfahren nach Anspruch 1 und Anspruch 14, 
dadurch gekennzeichnet, daB das Ergebnis der Be- 
rechnung zur Entscheidung uber die Einleitung ei- 
nes Haltemanovers oder einer Ausweichbewegung 
verwendet wird. 

16. Verfahren nach Anspruch 1 und Anspruch 14, 
dadurch gekennzeichnet, daB die in das ortsfeste 
Koordinatensystem transformierten Entfernungs- 
bilder des Laser-Entfernungsbildsystems fur Er- 
kennung bewegter Objekte on-line (in Ist-Zeit) aus- 
gewertet werden. 

17. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB Verkehrsregeln fur die Begegnung 
von Fahrzeugen oder mobilen Plattformen im Zen- 
tralrechner gespeichert sind. 

18. Vorrichtung zur Durchfuhrung des Verfah- 
rens 1 zur Steuerung eines Fahrzeuges oder einer 
mobilen Plattform mittels eines Sensorsystems mit 
mindestens einem Laser- Entfernungsbildsysiem, ei- 
nem Koppelnavigationssystem und einem Zentral- 
rechner, dadurch gekennzeichnet, daB mit dem 
Koppelnavigationssystem kontinuierlich inkremen- 
tale Positionsveranderungen gemessen werden, zur 
Berechnung von Position und Vektor des Fahrzeu- 
ges oder der mobilen Plattform addiert werden, in 
den Zentralrechner iibertragen werden, mit dem 
Laser-Entfernungsbildsystem kontinuierlich wah- 
rend der Bewegung Oberflachenpunkte der Umge- 
bung oder Segmente der Umgebung mit einem 
oder mehreren EntfernungsmeBstrahlen hinsich- 
tich der Entfernung und des Winkels relativ zum 
Fahrzeug oder der mobilen Plattform vermessen 
werden, die MeBergebnisse der Umgebungsver- 
messung in den Zentralrechner iibertragen werden, 
mit dem Vektor und der Position des Fahrzeugs 
oder der mobilen Plattform, zugehorig zum Zeit- 
punkt der MeBpunktaufnahme in ein fahrzeugun- 
abhangiges ortsfestes Koordinatensystem transfor- 
miert werden, der Zentralrechner aus diesen Daten 
Steuersignale fur den Antrieb und Lenkung errech- 
net. 

19. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Entfernungsmessung nach 
dem PulslaufzeitmeBverfahren arbeitet 

20. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Entfernungsmessung nach 
dem Phasenvergleichsverfahren arbeitet. 

21. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB Sender und Empfanger des Ent- 
fernungsmessers glasfasergekoppelt sind und die 
Elektronik vom Optikteil des Entfernungsmessers 
separiert ist 

22. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Entfernungsmessung nach 
dem Triangulationsverfahren arbeitet 

23. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB mehrere EntfernungsmeBstrah- 
len und Entfernungsauswerteschaltungen parallel 
verwendet werden. 

24. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die MeBstrahlablenkung durch 
Drehung des Entfernungsmessers urn die Hochach- 
se des Fahrzeuges erfolgt 

25. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, dafl der Entfernungsmesser im Ele- 
vationswinkel motorisch verstellt werden kann. 
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26. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daQ die MeBstrahlablenkung mittels 
motorisch verstellbarer Spiegel erfolgt. 

27. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Winkelstellung des den 5 
Strahl ablenkenden mechanischen Elementes mit 
einem Winkelencoder gemessen wird. 

28. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Winkelstellung des den 
Strahl ablenkenden mechanischen Elementes mit 10 
einem Potentiometer gemessen wird. 

29. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB das Laser-Entfernungsbildsy- 
stem rundum Sicht hat 

30. Vorrichtung nach Anspruch 18, dadurch ge- 15 
kennzeichnet, daB die Lastaufnahmevorrichtung 
oberhalb der Ebene des Fahrzeuges angebracht 
wird, aus der der MeBstrahl austritL 

31. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB der Zentralrechner aus Parallel- 20 
prozessoren mit zugeordneten Speichern besteht. 

32. Vorrichtung nach Anspruch 18 und An- 
spruch 31, dadurch gekennzeichnet, daB die einzel- 
nen Sensorsystemteile mit einzelnen Parallelpro- 
zessoren direkt Daten austauschen. 25 

33. Vorrichtung nach Anspruch 18 und An- 
spruch 31, dadurch gekennzeichnet, daB die Verar- 
beitung der anfallenden Sensordaten parallel er- 
folgt 

34. Vorrichtung nach Anspruch 18 und An- 30 
spruch31, dadurch gekennzeichnet, daB die Ar- 
beitsprogramme permanent gespeichert werden 
und zum Ablauf in den Parallelprozessoren in de- 
ren RAM-Speicher iibertragen werden. 

35. Vorrichtung nach Anspruch 18 und An- 35 
spruch31, dadurch gekennzeichnet, daB die Paral- 
lelprozessoren uber serielle Schnittstellen, soge- 
nannte Links, vernetzt sind und dariiber kommuni- 
zieren. 

36. Vorrichtung nach Anspruch 18, dadurch ge- 40 
kennzeichnet, daB der Informationsbestand auf ei- 
nem permanent speichernden Medium abgelegt 
wird. 

37. Vorrichtung nach Anspruch 18 und An- 
spruch 36, dadurch gekennzeichnet, daB das Spei- 45 
chermedium ein elektrisch gepufferter RAM-Spei- 
cher ist 

38. Vorrichtung nach Anspruch 18 und An- 
spruch 36, dadurch gekennzeichnet, daB die Spei- 
cherbausteine EEPROMs (electronically ereasable 50 
PROMs)sind. 

39. Vorrichtung nach Anspruch 18 und An- 
spruch 36, dadurch gekennzeichnet, daB die Infor- 
mationen auf magnetischen Datentragern gespei- 
chert werden. 55 

40. Vorrichtung nach Anspruch 18 und An- 
spruch 36, dadurch gekennzeichnet, daB die Infor- 
mationen auf einem optisch abtastbaren Daten- 
speicher gespeichert werden. 

41. Vorrichtung nach Anspruch 18, dadurch ge- 60 
kennzeichnet, daB die Informationen mittels einer 
Datenubertragungsstrecke von und zum Rechner 
iibertragen werden. 

42. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB der Informationsbestand auBer- 65 
halb des Fahrzeugs gespeichert wird. 

43. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Umgebungsinformationen 



vom Laser-Entfernungsbildsystem und Koppelna- 
vigationssystem durch Daten weitere Sensorsyste- 
me erganzt werden. 

44. Vorrichtung nach Anspruch 18 und 43, dadurch 
gekennzeichnet, daB das weitere Sensorsystem ein 
UltraschallhindernismeBsystem ist 

45. Vorrichtung nach Anspruch 18, 43 und 44, da- 
durch gekennzeichnet, daB das Ultraschallsystem 
aus mehreren Sensoren besteht die mit einer Ent- 
fernungsmeBschaltung verbunden sind. 

46. Vorrichtung nach Anspruch 18 und 43, dadurch 
gekennzeichnet, daB das Fahrzeug mit beruhrungs- 
empfindlichen Elememten ausgestattet ist 

47. Vorrichtung nach Anspruch 18 und 43, dadurch 
gekennzeichnet, daB als zusatzliches Sensorsystem 
zur Umgebungsvermessung und Erkennung ein 
Bildsystem mit Videokameras verwendet wird. 

48. Vorrichtung nach Anspruch 18 und 43, dadurch 
gekennzeichnet, daB mindestens eine Kamera Bil- 
der von dem vom Laser-Entfernungsbildsystem 
uberdeckten Bereich liefert, zu deren Bildauswer- 
tung die Entfernungsinformation genutzt wird. 

49. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB ein mit dem Sensorsystem aus- 
gerustetes Fahrzeug oder mobile Plattform zusatz- 
lich mit Arbeitsmitteln ausgerustet ist 

50. Vorrichtung nach Anspruch 18 und 49, dadurch 
gekennzeichnet, daB das Arbeitsmittel ein oder 
mehrere Roboterarme sind. 

51. Vorrichtung nach Anspruch 18 und 49 und 50, 
dadurch gekennzeichnet, daB an mindestens einem 
Roboterarm mindestens eine Videokamera befe- 
stigt ist 

52. Verfahren nach Anspruch 18 und 49, dadurch 
gekennzeichnet, daB das Arbeitsmittel ein Reini- 
gungswerkzeug ist 

53. Vorrichtung nach Anspruch 18 und 49, dadurch 
gekennzeichnet, daB das Arbeitsmittel ein Rasen- 
schneider ist. 

54. Vorrichtung nach Anspruch 18 und 49, dadurch 
gekennzeichnet, daB das Arbeitsmittel ein Last- 
ubernahme-/Obergabemittel ist 

55. Vorrichtung nach Anspruch 18 und 49, dadurch 
gekennzeichnet, daB das Arbeitsmittel ein Contai- 
ner Aufnahmemittel ist 

56. Vorrichtung nach Anspruch 18 und 43, dadurch 
gekennzeichnet, daB als zusatzliches Sensorsystem 
zur Umgebungsvermessung ein Feinpositionie- 
rungssystem verwendet wird 

57. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB das Koppelnavigationssystem 
ein odometrisches System ist 

58. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB das Koppelnavigationssystem 
aus mehreren Korrelationssensoren besteht, mit 
denen durch optische Korrelationmethoden die Be- 
wegung uber Grund vom Fahrzeug aus gemessen 
wird. 

59. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet daB das Koppelnavigationssystem 
aus mehreren Schallsende/Empfangseinrichtungen 
besteht und die durch die Bewegung hervorgerufe- 
ne Frequenzverschiebung des in mehrere Richtun- 
gen schrag auf den Boden gerichteten Schalls, zur 
Geschwindigkeitsbestimmung verwendet wird. 

60. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB als Sensor im Koppelnaviga- 
tionssystem ein Kreisel integriert ist, mit dem die 
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Anderung des Fahrzeugvektors festgestellt wird. 

61. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB das Laser-Entfernungsbildsy- 
stem unempfindlich geschaltet wird und nur als 
Marken in die Umgebung plaziene Reflektoren de- 5 
tektiert. 

62. Vorrichtung nach Anspruch 18, dadurch ge- 
kennzeichnet, daB die Amplitude des reflektierten 
Signals gemessen und als Information fur die Urn- 
gebungserkennung herangezogen wird. 10 
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